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problems  defined  on  the  special  Euclidean  group  and  demonstrate  by  appealing  to 
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1.  Introduction 

In  this  paper,  we  discuss  a  class  of  optimal  control  problems  on  Lie  groups,  focusing 
on  the  special  Euclidean  groups  SE(n).  The  models  we  discuss  arise  in  the  dynamics 
and  control  of  unmanned  aerial  vehicles  (Justh  &  Krishnaprasad  2002,  2004,  2005), 
in  continuum  models  in  biophysics  (Wiggins  2001)  and  in  fluid  mechanics  (Newton 
2001).  In  his  Ph.D.  thesis  (Baillieul  1975,  1978),  John  Baillieul  investigated  optimal 
control  problems  on  matrix  Lie  groups  using  the  Maximum  Principle  of  Pontryagin 
and  methods  from  the  calculus  of  variations,  emphasizing  in  Chapter  3  of  the  thesis 
the  details  of  the  special  case  of  SO( 3).  The  present  paper  is  somewhat  in  the  spirit 
of  that  chapter,  seeking  explicit  solutions  while  finding  common  patterns  in  a  wider 
class  of  problems. 

In  Section  2  of  this  paper  we  set  up  a  notation  explaining  the  natural  framing  of 
twice  differentiable  curves  in  M3.  In  Section  3  we  discuss  optimal  control  problems 
with  symmetry  on  a  Lie  group  and  state  the  reduction  of  the  Maximum  Principle  to 
the  dual  of  the  Lie  algebra.  With  this  as  the  starting  point  we  show,  with  the  help 
of  examples,  that  in  SE(n)  the  extremals  are  stationary  solutions  to  a  nonlinear 
Schrodinger  equation.  Connections  to  vortex  filament  equations  that  yield  singular 
solutions  in  fluid  mechanics  (Newton  2001,  Ricca  1996)  are  also  indicated.  In  the 
work  of  Langer  and  Perline  (1991,  1996)  connections  between  the  vortex  filament 
equation  and  the  nonlinear  Schrodinger  equation  are  discussed  using  natural  frames 
and  generalizations. 


2.  Natural  frame  representation  of  curves 

Given  a  curve  7  :  K.  — >  IR3  which  is  at  least  twice  continuously  differentiable,  we 
can  associate  with  it  a  natural  Frenet  frame  {T,Mi,M2}  which  evolves  according 
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to  (Bishop  1975) 


1  =  T, 

T7  =  fciMi  +  /C2M2, 

=  -kx  T, 

M'2  =  -fc2T,  (2.1) 


where  prime  denotes  differentiation  with  respect  to  the  arc  length  parameter  s, 
T  is  the  unit  tangent  vector  to  the  curve,  Mi  and  M2  are  unit  normal  vectors, 
and  [T  Mi  M2]  €  SO( 3).  The  natural  curvatures  kx  and  k2  can  be  thought  of 
as  controls:  given  an  initial  position  7(0)  and  initial  choice  Mi(0)  and  M2(0),  the 
functions  kx  :  M.  — >  K.  and  k2  :  M.  — >  K.  completely  determine  the  curve. 

The  natural  Frenet  frame  equations  (2.1)  can  be  written  as  a  left-invariant 
system  on  SE( 3)  as 

9  =  9t,  (2-2) 

with 


9  = 

i  = 


T 

0 

0 

kx 

k2 

0 


Mi 

0 

-kx 

0 

0 

0 


M2  7 
0  1  _ 

—k2  1 
0  0 
0  0 
0  0 


G  SE( 3), 

G  se(3). 


(2.3) 


Curves  and  natural  Frenet  frames  have  proved  useful  for  designing  coordinated 
vehicle  trajectories  for  tasks  such  as  pursuit  (Justh  &  Krishnaprasad  2006;  Reddy, 
Justh  &  Krishnaprasad  2006),  formation  flight  (Justh  &  Krishnaprasad  2004,  2005), 
and  boundary  tracking  (Zhang,  Justh  &  Krishnaprasad  2004).  They  have  also  been 
applied  to  gather  evidence  for  particular  pursuit  strategies  in  nature  (Reddy,  2007). 

An  alternative  framing  of  the  curve  7  (when  7  is  three  times  continuously 
differentiable  and  7"  7^  0)  is  the  Frenet-Serret  frame 

i  =  T, 

T'  =  kN, 

N'  =  -kT  +  tB, 

B'  =  -tN,  (2.4) 

where  k  is  the  curvature,  r  is  the  torsion,  N  is  the  unit  normal  vector,  and  B  is  the 
unit  binormal  vector.  The  Frenet-Serret  equations  (2.4)  can  also  be  expressed  as  a 
left-invariant  system  on  SE( 3),  and  there  are  formulas  which  relate  k  and  r  to  the 
natural  curvatures  kx  and  k2.  For  example, 

k2  =  k\  +  k\,  r  =  ^-  [arg(fci,  k2)\  =  [tan-1(/c2/&i)l  .  (2.5) 

as  as 

Circular  helical  curves  are  easily  described  using  the  Frenet-Serret  frame,  be¬ 
cause  k  and  r  are  constant.  The  corresponding  natural  curvatures  kx  and  k2  are 
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sinusoidal  functions  of  s  (in  phase  quadrature).  A  right  circular  helix  with  radius 
p,  pitch  2tt r,  and  initial  point  7(0)  =  (p.  0, 0)  is  described  by 

pcas(s/\J p2  +  r2) 

'y(s)  =  psin(s/ \J  p2  +  r2)  ,  (2.6) 

rs/  \J  p2  +  r2 


so  that 


T(«)  =  y  = 


'  p2  +  r2 


— psin(s/  \J  p2  +  r2) 
pcos(s/^/p2  +  r2)  , 


and  corresponding  explicit  formulas  for  Mi(s)  and  M2(s)  can  also  be  derived.  The 
curvature  and  torsion  are  given  by 

n=\i'\  =  p/{p2  +  r2)  (2.8) 


r  =  y.(7"x7",)/^  =  r/(p2  +  r2). 


3.  Maximum  Principle  and  Poisson  Reduction 

The  use  of  the  Maximum  Principle  and  Lie-Poisson  Reduction  for  left-invariant 
systems  on  finite  dimensional  Lie  groups  is  discussed  in  (Krishnaprasad  1993).  Here 
we  summarize  the  main  points,  as  they  apply  to  the  problems  analyzed  below.  Given 
a  controlled  left-invariant  system 

g  =  gfu,  (3.1) 

where  g  £  G,  a  Lie  group,  and  £  g,  the  corresponding  Lie  algebra,  we  assume 
that  is  affine  in  the  control  vector  u,  i.e. , 

m 

£«  =  £0  +  5Z «»(*)&,  *  =  0,1  ,...,m.  (3.2) 

In  (3.2),  u  =  (ui,U2,  —,um)  €  Rm,  &  €  {X1}  X2, Xn},  a  set  of  basis  vectors  for 
g,  and  m  <  n  where  n  is  the  dimension  of  G.  Thus,  the  system  is  underactuated. 
In  particular,  we  assume  that 

£0  =  cr0Xq  for  some  q  £  {m  +  1,  ...,n},  do  £  {—1,0, 1}, 

&  =  <7iXi,  di  £  {  1,1},  i  =  1, ...,  m,  (3.3) 


and  we  take  L  to  have  the  form 


L (U)  = 


If  do  =  0  then  the  system  is  drift-free;  otherwise,  the  system  has  drift.  We  consider 
the  fixed-endpoint  problem 


min  /  L(u(t))dt 

u  Jo 
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subject  to  ^(0)  =  go  and  g(T)  =  gr,  T  >  0,  and  note  that  L  given  by  (3.4)  is  clearly 
G- invariant  (i.e.,  L  depends  only  on  u  and  not  on  g).  Assuming  that  controls  exist 
which  will  drive  the  system  from  go  at  t  =  0  to  gr  at  t  =  T,  and  restricting  attention 
to  regular  extremals  of  the  fixed  endpoint  problem,  we  define  the  pre-hamiltonian 

H(g,p,u)  =  ( p,TeLg  ■  Cu)  -  L(u),  (3.6) 

where  p  £  T*G  and  TeLg  denotes  the  tangent  map  of  left  translation  by  g  on  G. 
The  Maximum  Principle  then  states  that  for  optimal  «(■),  the  trajectory  in  G  is  a 
base  integral  curve  of  the  canonical  hamiltonian  system  on  T  G  with  hamiltonian 


H(5,p)  =  sup  H(g,p,u),  for  a.e.te  [0,T], 


(3.7) 


where  H  is  the  hamiltonian.  If  H  is  differentiable  with  respect  to  u,  we  have 
dH , 


du, 


ig,p,u) 


—  ITT  t  \  -  — 
d  (p,TeLg^u) 


=  0,  i  =  1, ...,  m.  (3.8) 


Defining  p  £  g*,  the  linear  dual  of  g,  by  p  =  TeL*  ■  p,  and  substituting  (3.4)  for  L, 
(3.8)  becomes 


d  ,  t  \  dL 
du 4  du, 


d 


m 


=  ( m, 


ou 


=  E  (v,  Ci)  - 


i—  1 
opt 


opt 


=  E  0i  Ob  Xi)  ~ 


opt 


=  CTiPi  -  U°pt  =  0, 

where  p  is  expressed  in  the  dual  basis  {X^X^,  to  that  of  g,  as 


M 


=  EEm*- 


Thus,  the  optimal  controls  u°pt  satisfy 

u°pt  =  (Tipi,  i  =  1, ...,  m. 

Substituting  the  optimal  controls  back  into  the  hamiltonian  then  gives 
H (g,p)  =  (p,  TeLg  ■  £uoPt)  —  L(uopt) 

=  (p,M-L(uopt) 


—  ( Mi  Co  +  y '  TJiPi^i  \  y ' 


Mi 


=  (To  (M,  xq)  +  E  (m,  XiPi)  -  -  E 

i=l  1 

^  m 

=  v0pq  +  -  Em?- 


Mi 


(3.9) 

(3.10) 

(3.11) 


(3.12) 
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Clearly  H  is  independent  of  g ,  and  thus  permits  reduction.  In  fact,  we  are  able  to 
use  Lie-Poisson  reduction  to  take  the  original  system  on  T*G  and  reduce  it  to  a 
system  on  0*,  with  the  reduced  variables  defined  as  pi, ...,  pn.  The  machinery  of 
Lie-Poisson  reduction  (technical  details  may  be  found  in  Krishnaprasad,  1993)  then 
allows  us  to  write  the  reduced  hamiltonian 


h  = 


i— 1 


along  with  the  dynamics  for  /i, 


A*  =  ~ 


££>*r« 


3=1  fe=l 


(3.13) 


(3.14) 


where  Tf  •  are  the  structure  constants  of  g.  We  can  express 


(3.14)  in  the  form 


f 

TJ 

■p/c 

1  12 

pk 

1  In 

dh/dp i 

p  =  A  (p)Vh  =  — 

n 

~pk 

1  21 

~pk 

1  22 

P'k 

1  2  n 

dh/dp 2 

k= 1 

i 

TJ 

3  3S-  • 

-pk 

1  n2 

T-'fc 

^  nn  - 

) 

_  dh/dpn 

which  turns  out  to  be  more  illuminating. 


Remark:  We  focus  on  extremal  solutions,  i.e.,  solutions  which  satisfy  the  necessary 
condition  (3.8)  for  optimality.  Because  we  have  not  considered  (second-derivative- 
based)  sufficient  conditions,  or  analyzed  conjugate  points,  we  cannot  assert  that 
these  solutions  are  truly  optimal  without  doing  more  work.  However,  we  shall  con¬ 
tinue  to  refer  to  the  controls  u°pt  as  the  “optimal  controls.” 


4.  Optimal  framing 

We  apply  the  Maximum  Principle  and  Lie-Poisson  reduction  to  fixed-endpoint  op¬ 
timal  control  problems  on  50(3),  SE( 3),  and  SE( 4)  (with  implications  for  the 
corresponding  problem  on  SE(n),  n  >  4).  For  50(3),  we  obtain  explicit  equa¬ 
tions  for  not  only  the  optimal  controls,  but  also  the  corresponding  solutions.  For 
SE( 3),  we  show  that  the  optimal  controls  are  stationary  solutions  to  a  nonlinear 
Schrondinger  (NLS)  equation.  For  SE( 4),  the  optimal  controls  are  stationary  solu¬ 
tions  to  a  three-dimensional  generalization  of  the  stationary  NLS  (SNLS)  equation, 
a  pattern  which  also  holds  for  SE(n),  n  >  4. 

(a)  An  optimal  control  problem  on  SO (3) 

Consider  the  left-invariant  system 

g  =  g£u,  g  &  SO( 3),  fu  =  x1u1-x2u2,  (4.1) 


'  0 

-1 

0  ' 

0 

0 

1  ■ 

II 

* 

1 

0 

0 

II 

0 

0 

0 

1 

o 

0 

1 

o 

_  -1 

0 

1 

o 

where 
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Suppose  that  the  endpoints  for  a  fixed-endpoint  optimal  control  problem  are  given 
by  5(0)  =  go,  g(T)  =  gx,  and  we  seek  (regular  extremals  which) 


min 

(ni,U2)GM2 


L{ui{t)1u2{t))dt1 


(4.3) 


where 

L(U!,U2)  =  -  (u\  +ul) .  (4.4) 

This  problem  clearly  fits  within  the  class  of  problems  described  in  the  previous 
section,  with  ao  =  0  since  there  is  no  drift  term  in  Because  there  is  no  drift,  by 
the  Lie  Algebra  Rank  Condition  (LARC)  (Jurdevic,  1997),  it  is  easily  verified  that 
the  system  is  controllable,  and  therefore  controls  exist  which  will  steer  the  system 
from  go  at  t  =  0  to  gx  at  t  =  T.  Thus,  we  may  apply  the  Maximum  Principle  and 
Poisson  reduction  to  obtain  the  reduced  hamiltonian 


h 


1 

2 


(m?  +  m!)  > 


(4.5) 


and  the  reduced  dynamics  (3.14),  where  n  =  3.  The  structure  constants  are  easily 
found  from 

[X1,X2]  =  -X3,  [XUX3]=X2,  [X2,  X3]  =  —X\,  (4.6) 

to  be 

T?2  =  -l,  ri3  =  1)  r23  =  “I.  (4-7) 

with  rb  =  —  T*)  and  !’()  =  0  for  all  1  <i,j,k<  3.  The  reduced  dynamics  are  thus 


’  Ai  " 

0 

-M3 

M2 

’  Mi  ’ 

M2M3 

A2 

=  — 

M3 

0 

Mi 

M2 

= 

-M1M3 

.  A3  . 

.  “M2 

Mi 

0 

0 

0 

(4.8) 


It  is  clear  that  the  reduced  hamiltonian  (4.5)  is  conserved,  as  is  the  Casimir 


c  —  2  (vl  +  M 2  +  M 3)  •  (4-9) 

Conservation  of  h  and  c  imply  that  2(c  —  h)  =  is  also  conserved,  which  is  easily 
seen  from  (4.8).  The  optimal  controls  thus  take  the  form 


u\(t)  =  V2hcos(ujt  +  (j>),  u2{t)  =  —\/2hsvLi(u>t  +  </>),  (4-10) 


where  and  4>  £  S1  (i.e.,  the  circle  group). 

It  is  possible  to  write  down  explicit  solutions  for  the  corresponding  trajecto¬ 
ries  in  SO( 3)  by  identifying  time  t  with  arc  length  parameter  s,  noting  that  the 
sinusoidal  optimal  controls  (4.10)  are  in  phase  quadrature,  and  interpreting  the 
optimal  controls  as  the  natural  curvatures  for  a  circular  helix  in  R3.  If  we  assume 
that  u)  >  0  (the  u>  <  0  case  may  be  treated  similarly),  we  can  use  the  formulas  for 
a  right  circular  helix  from  section  2  to  derive 


9  =  [  x  y  z  ]  , 


(4.11) 
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with 


x  =  U>i 


— psin(wit) 
pcos(wit) 
r 


y  =  —u)iV2h 


z  =  wi\/2 ~h 


2 (^)  COs(wit  +  Wt  +  0)  +  COs(W!t  -  Ut  -  <j>) 

sin(wit  +  wi  +  <f>)  +  2{^_u)  sin(wi t  -  wt  -  <j>) 
£  sin  (ut  +  4>) 

2(Zhfe7)  sin(^i*  +  +  <t>)  -  2(^7)  sin (w it  -wt-ifi) 

~2 ttjf+tJ)  COs(wit  +  +  0)  +  2(^J)  COs(wit  -Utt-<ji) 

5  cos(wf  +  </>) 


(4.12) 


where  w4  =  l/\/p2  +  r2,  p / (p2  +  r2)  =  \/2h  and  r/(p2  +  r2)  =  w.  Thus,  (4.11)  and 
(4.12)  can  be  written  as  functions  of  h,  to,  <j>,  and  t  alone.  The  parameters  h,  u>,  and 
(j>  need  to  be  chosen  to  satisfy  g(T)  =  g{0)gQ1gr- 


( b )  ^4n  optimal  control  problem  on  SE(3) 

Now  consider  the  fixed  endpoint  problem  g  =  g£u,  where  £„  is  given  by 

£ u  =  -X4  +  X1U1  —  X2u2,  (4-13) 

where 


'  0 

0 

0 

1  ' 

'  0 

-1 

0 

0  ' 

0 

0 

1 

0  ' 

0 

0 

0 

0 

,  *1  = 

1 

0 

0 

0 

,  *2  = 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-1 

0 

0 

0 

1 - 

0 

0 

0 

0  _ 

_  0 

0 

0 

0  _ 

0 

0 

0 

0  _ 

(4.14) 

and  m  =  2,  n  =  3.  The  fixed  endpoints  in  SE( 3)  are  denoted  by  p(0)  =  go  and 
g(T)  =  gr,  L{u)  is  given  by  (4.4),  and  we  note  that  fu  does  have  a  drift  term.  We 
can  view  g  =  as  the  natural  Frenet  frame  system  (2.1),  where  we  identfy  the 
controls  («i,—  u2)  with  the  natural  curvatures  (ki,k2)- 

Remark:  We  assume,  but  do  not  verify,  that  controls  (ui ,  u2)  exist  which  will 
take  the  system  from  g0  at  t  =  0  to  gx  at  t  =  T.  Because  drift  is  present  in  this 
system,  proving  the  existence  of  such  controls  is  more  complicated  than  in  the 
^0(3)  example  above,  even  though  the  local  strong  accessibility  condition  is  met 
(Jurdevic,  1997).  For  example,  we  must  have 

l(<?o“V)e4|2-l<T,  (4.15) 

where  e4  =  [  0  0  0  1  ]T,  or  it  will  be  impossible  to  find  any  (m,  U2)  which  satisfies 
the  endpoint  conditions.  In  terms  of  curves,  (4.15)  simply  states  that  the  distance 
(in  arc  length)  between  the  initial  and  final  position  (in  M3)  must  not  exceed  the 
time  T  (multiplied  by  unit  speed). 
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We  now  compute  the  Lie-Poisson  reduced  equations.  Using  the  standard  basis 
for  SE( 3),  we  compute  the  structure  constants 


r4  —  —i  rz  —  i  r1  — 

1 12  ^  u  1 13  -  u  1 23  — 
r5  —  r4  —  r6  —  i 

f4  —  f6  —  r5  — 

1  15  —  1  24  —  1  36  — 


-1, 


(4.16) 


=  -r and  It 
j  =  1, ...,  6,  found  from  (3.14)  are  thus 


=  — r*-,  and  T'lj  =  0  for  all  other  1  <  i,j,k  <  6.  The  dynamics  for  jj,j, 


M3M2  -  M 5 
— M3M1  +  M6 
0 

M5Ml  -  M6M2 
~M4Ml 
M4M2 

(4.17) 

(4.18) 


'  Mi  ' 

M2 

M3 

M4 

M5 

.  Me  . 

'  0 

-M3 

M2 

M5 

-M4 

0  ' 

M3 

0 

-Mi 

-Me 

0 

M4 

“M2 

Mi 

0 

0 

Me 

— M5 

— Ms 

Me 

0 

0 

0 

0 

M4 

0 

-Me 

0 

0 

0 

0 

-M4 

Ms 

0 

0 

0 

Mi 

r 

M2 

0 

1 

0 

0 

Conserved  quantities  include  the  (reduced)  hamiltonian, 

1 


h  —  p,  4  +  -(/x?  +  n\), 


and  the  two  Casimir  functions 


ci  =2  (m2  +  M§  +  M§), 

C2  =  MlM6  +  M2M5  +  M3M4- 


(4.19) 


As  in  the  optimal  control  problem  on  50(3)  described  in  the  previous  subsection, 
/i3  is  constant,  as  can  be  seen  directly  from  (4.17). 


(i)  Connection  to  the  nonlinear  Schrodinger  equation 
Defining 


a  = 


Mi 

M2 


b  = 


—  M5 
Me 


,  cu  =  =  constant, 


(4.20) 


we  have 


where 


h  =  M4+^-, 

Cl  =  ^  (m!  +  |t>|2) 

C2  =  w/xj  +  bT  Ja, 


J  = 


0  -1 

1  0 


(4.21) 

(4.22) 


Optimal  natural  frames 


9 


The  dynamics  (4.17)  become 


a  =  —  to  Ja  +  b, 
b  =  (h-^ 


which  can  be  written  in  terms  of  a  alone  as 


a  +  w Ja  —  (  h - —  )  a  =  0. 


(4.23) 


(4.24) 


We  can  now  use  a  change  of  variables  to  eliminate  the  a  term  from  (4.24).  Defining 
a  by 

a  =  exp  f —  -uiJt  \  a. 


we  have 


and 


1 


a  =  —  exp  —ujJt  -uJ  a  +  exp  —  - uiJt  a, 


1 


(4.25) 

(4.26) 


1 


1 


1 


1 


a  =  exp  -uJt.j  -ur  Jla  —  exp  -LuJtj  ujJa  +  exp  -uJtj  a.  (4.27) 
Substituting  into  (4.24)  and  multiplying  through  by  exp  we  obtain 


7W2J2a  —  u>  Ja  +  a  +  uJ 
4 


— -wJa  +  a 


-  h- 


=  a+Va-  ft-^  a  =  0. 


(4.28) 


Defining  h  =  h  —  ,  we  finally  obtain 


a  —  ha  +  -  |a|2a  =  0. 


(4.29) 


Consider  the  (focusing  cubic)  nonlinear  Schrodinger  equation  (NLS)  (with  an 
additional  linear  term), 


.dip  d2ip  ~  1 1  ,2  . 

-'m  =  d^-h*+2W  * 


(4.30) 


where  ip(t,x)  is  a  complex  function  of  time  t  and  position  x  £  R.  Identifying  the 
variable  x  in  (4.30)  with  t  in  (4.29)  and  [  Ke(ip)  Im (ip)  }T  in  (4.30)  with  a  in  (4.29), 
we  see  that  (4.29)  can  be  viewed  as  a  stationary  NLS  (SNLS). 


(ii)  Special  solutions  of  SNLS 

Among  the  solutions  to  (4.29)  are  two  easily  obtained  classes:  sinusoidal  solu¬ 
tions  and  (Jacobi)  elliptic  function  solutions.  For  the  sinusoidal  solutions,  we  have 


a  =  a 


cos(wf  +  (p) 
sin(cc<  +  (p ) 


(4.31) 
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where  a  =  |a|  is  a  constant  amplitude,  and  </>  is  a  constant  phase.  Then  a  must 
satisfy 

—aid2  —  ha  +  ^a3  =  0,  (4.32) 

or 

a  =  \J  2(d>2  +  h2),  (4.33) 

where  u>,  h,  and  cj>  are  determined  by  the  specified  endpoints  go  and  gr  (assuming 
that  there  exist  curves  in  SE( 3)  corresponding  to  these  sinusoidal  solutions  which 
actually  interpolate  go  and  gr). 

To  describe  the  elliptic  function  solutions,  we  represent  a  as 


a  = 


cos  0 

•  a  °> 
smu 


(4.34) 


where  6  is  constant  and  a  is  a  scalar-valued  function.  For  this  class  of  solutions, 
(4.29)  implies 

a  —  ha  +  ^a3  =  0.  (4.35) 

Equation  (4.35)  has  solutions  of  the  form 


a{t) 


(2is^/m)cn(is(t  — 


(4.36) 


where  rj,  is,  and  m  are  constant,  and  v  satisfies  v2  >  \h\  (Davis,  1962).  To  con¬ 
nect  back  to  the  original  optimization  problem,  these  elliptic  function  solutions 
correspond  to  optimal  controls  for  g  =  g£u,  with  given  by  (4.13),  of  the  form 


Ui 

(  1  T+\ 

cos  9 

=  a  =  exp  —  -ujJt 

sin  9 

-U2 

V  2  J 

(4.37) 


where  a  given  by  (4.36),  h  =  h  —  |w2,  and  the  constants  u>,  h ,  9 ,  ij,  and  is  are 
determined  by  the  endpoints  go  and  gx  (if  such  constants  exists).  Of  course,  we 
could  have  written  an  analogous  expression  for  the  optimal  u±  and  u-2  corresponding 
to  the  sinusoidal  solutions,  as  well.  The  point  is  that  we  can  work  with  the  Lie- 
Poisson  reduced  equations  to  ultimately  obtain  explicit  formulas  (for  the  controls) 
for  certain  extremal  solutions  to  the  fixed-endpoint  optimal  control  problem  on 
SE(3),  and  a  key  step  is  recognizing  that  the  reduced  equations  can  actually  be 
massaged  into  the  form  of  a  stationary  NLS  equation. 

(c)  ^4n  optimal  control  problem  on  SE(4) 

It  turns  out  that  the  techniques  used  above  for  the  fixed-endpoint  problem  on 
SE(3)  can  be  generalized  to  higher  dimensions.  We  first  use  SE(4)  for  illustration, 
and  then  proceed  to  the  general  case.  Consider  the  fixed  endpoint  problem  g  =  g^u 
for  g  £  SE( 4),  where 


Cu  —  X7  +  X\U\  +  X2U2  +  X3U3 


(4.38) 
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'  0 

-1 

0 

0 

0  ' 

1 

0 

0 

0 

0 

,  X2  — 

0 

0 

0 

0 

0 

1 - 

0 

0 

0 

0 

0  _ 

'  0 

0 

0 

-1 

0  ' 

0 

0 

0 

0 

0 

>  x7  = 

0 

0 

0 

0 

0 

_  1 

0 

0 

0 

0  _ 

00-100 
0  0  0  0  0 

1  0  0  0  0 

0  0  0  0  0 

0  0  0  0  1  ' 

0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


L(u )  =  ^  (ui  +  ul  +  ul)  ■  (4-4°) 

For  a  particular  choice  of  basis  for  the  Lie  algebra  se( 4)  (in  particular,  {X7,  ...,X6} 
correspond  to  rotation  while  { X 7,  ...,Xio}  correspond  to  translation),  we  have 

h  =  p 7+2  (Mi  +  M2  +  M3)  >  (4-44) 

and  the  Lie-Poisson  reduced  equations  are  computed  to  be 


Mi  -M4M2  ~  M5M3  -  M 8 

M2  M4Mi  -  M6M3  -  M9 

M3  MsMi  +  M6M2  —  M10 

M4  0  0 

2  =  -A("}  =  0 
M  7  1  MsMi  +  M9M2  +  M10M3 

Ms  Q  — M7Mi 

M9  q  -M7M2 

.  M10  q  _  -M7M3 

where 


0 

M4 

M5 

-M2 

-M3 

0 

Ms 

~M  7 

0 

0 

-M  4 

0 

Me 

Mi 

0 

-M3 

M9 

0 

-M7 

0 

—  M5 

-Me 

0 

0 

Mi 

M2 

M10 

0 

0 

M7 

M  2 

-Mi 

0 

0 

Me 

—  M5 

0 

M9 

-Ms 

0 

M  3 

0 

-Mi 

-Me 

0 

M4 

0 

M10 

0 

-Ms 

0 

M3 

-M2 

M  5 

~M4 

0 

0 

0 

M 10 

-M9 

-Ms 

-M9 

— M 10 

0 

0 

0 

0 

0 

0 

0 

M  7 

0 

0 

-M9 

— M10 

0 

0 

0 

0 

0 

0 

M  7 

0 

Ms 

0 

— M10 

0 

0 

0 

0 

0 

0 

M7 

0 

Ms 

M  9 

0 

0 

0 

0 
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Defining 


’  Mi  ’ 

Ms 

M4 

a  = 

1 

CO  to 

1 _ 

T  b  =  - 

M9 

Mio 

,  n  = 

M  5 

.  Me  . 

we  have  from  (4.42) 


a  =  — fia+b. 


where  the  optimal  controls  are  given  by 


Ml 

U2 

U3 


=  a. 


(4.44) 


(4.45) 


(4.46) 


Note  that  the  form  of  (4.45)  is  analogous  to  (4.23),  except  that  now  a  and  b  are 
3-dimensional  vectors.  Indeed,  (4.45)  leads  to  a  generalization  of  the  SNLS  equation 
(see  the  next  subsection).  Among  the  solutions  to  (4.45)  are  sinusoidal  and  elliptic 
function  solutions  analogous  to  those  obtained  in  the  SE( 3)  example  of  the  previous 
subsection. 


( d )  An  optimal  control  problem  on  SE(n) 

More  generally,  we  can  consider  the  fixed  endpoint  problem  g  =  g^u  for  g 
SE(n ),  where  se(n )  is  parameterized  such  that  {A”i#.s..,  Xnrn_u  /2}  correspond  to 
rotation  and  {X[n(n-i)/2+i]i  •••>  Xn(n+i)/2}  correspond  to  the  translation,  and 

=  X[n(n-  l)/2+l]  +  AlUi  +  X2U2  +  •  •  •  +  Xn-\Un-\.  (4.47) 

In  particular,  Xi,...,Xn_i  take  the  following  form:  the  [1,(1  +  k)]  component  of 
Xk  is  —1,  the  [(1  +  k),  1]  component  of  X &  is  1,  and  all  other  components  of  X k  are 
zero.  (A  particular  form  for  all  of  the  basis  vectors  for  se(n)  is  chosen  so  that  the 
patterns  in  the  calculation  are  clear:  the  n  =  4  case  is  illustrative.)  We  consider  the 
cost  function 

L(n)  =  -  (uf  +  ul  +  ...  +  m^_x)  ,  (4.48) 

and  we  have 

h  —  Ii[n(n-l)/2+l]  +  ^  (Pi  +  Ll 2  +  •••  +  Pn- 1)  •  (4.49) 

We  define 


Mi 

M[n(n- l)/2+2J 

a  = 

M2 

■  b  =  - 

M[n(n— 1)/2+3] 

,  Cl  =  n(Mn,-,Mn(n-l)/2)  (4-50) 

Mn—  1 

Mn(n+l)/2 

where  a  and  b  are  vectors  of  length  n—1  and  O  is  an  (n— 1)  x  (n—  1)  skew-symmetric 
matrix.  We  can  verify  that,  indeed  O  is  constant.  We  then  have,  analogously  to  the 


Optimal  natural  frames 


13 


calculation  for  SE(4),  that  a  and  b  obey 


(4.45)  with  optimal  controls  given  by 


u  1 
U2 

1 


(4.51) 


Writing  (4.45)  In  terms  of  a  alone,  we  have 


a  -\-  Oa 


|a£ 

2 


a  =  0. 


(4.52) 


Defining  a  by 


a, 


we  use  the  analogous  calculation  to  the  one  for  SE( 3)  to  obtain 


a  —  H  a 


|a|2a  =  0, 


(4.53) 


(4.54) 


where 


H  1)  x  (n— 1) 


(4.55) 


is  a  constant,  symmetric  matrix.  Equation  (4.54)  can  be  considered  a  vector  version 
of  the  stationary  NLS,  and  among  its  solutions  are  classes  of  solutions  analogous 
to  the  sinusoidal  and  elliptic  function  solutions  identified  in  the  analysis  for  SE(3). 


5.  Physics 

The  nonlinear  Schrodinger  equation  appears  in  the  study  of  the  DaRios-Betchov, 
or  vortex  filament  equation  (Betchov,  1965).  Vortex  filaments  are  persistent  slender 
filamentary  structures  observed  in  three-dimensional  fluid  flows,  and  they  exhibit 
self-induced  motion  (and  shape  change)  due  to  the  curvature  distribution  along  the 
filament.  The  identification  of  vortex  filament  shapes  and  their  stability  has  been 
studied  extensively  over  the  past  half-century  due  to  the  aeronautical  importance 
of  vortices  in  fluid  flow  over  airfoils. 

Vortex  filaments  can  be  modeled  using  curves  and  natural  Frenet  frames,  where 
the  vortex  filament  is  modeled  as  a  curve  in  three-dimensional  space  which  does 
not  change  length,  but  which  can  move  and  change  shape  with  time.  In  place  of 
(2.1),  we  have  the  partial  differential  equation 

Is  =  T, 

Ts  =  fciMi  +  ^2^2, 

Mls  =  —  kiT, 

M2s  =  -kiT,  (5.1) 

where  7  and  {T,Mi,M2}  are  functions  of  both  time  t  and  arc-length  parameter 
s.  The  DaRios-Betchov  equation  (or  vortex  filament  equation)  is 


It  =  Is  X  Ifss, 


(5.2) 
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and  it  describes  the  evolution  of  the  curve  representing  the  vortex  filament  evolving 
in  three-dimensional  space.  Note  that  (5.2)  is  length-preserving,  i.e. , 

d  i.  I  _  7s  '1st  _  Is  "Its  Is  ■  (iss  x  7SS  +  Is  x  7SSS)  n  ,c 

dthsl~  |7s|  ”  |7S|  ”  |7S|  (  j 

Equation  (5.2)  possesses  even  more  structure:  the  Hasimoto  transformation  shows 
that  the  natural  curvatures  {k\ ,  h?)  in  (5.1),  evolving  according  to  (5.2),  are  given 
by  a  nonlinear  Schrodinger  equation  (Hasimoto,  1972).  Analysis  of  the  DaRios- 
Betchov  equation  from  a  geometric  point  of  view,  using  natural  frames  and  the 
nonlinear  Schrodinger  equation,  can  be  found  in  the  work  of  Langer  and  Perline 
(1991,  1996). 

(a)  DaRios-Betchov  equation  and  NLS 

Using  the  fact  that  mixed  partial  derivatives  commute,  i.e.,  7st  =  7ts  and 
Tis  =  Tst,  after  some  calculation  we  obtain 


&2t  —  ( k\  +  k%)  —  A(t)^j  k\  +  kiss- 

where  Apt)  is  a  constant  of  integration.  An  analogous  calculation  gives 
kit  =  ^  (^i  +  ki)  +  A(t)^  k-2  —  fc2ss> 


To  show  the  connection  between  (5.4),  (5.5)  and  the  nonlinear  Schrodinger  equation, 
we  let 

ip  =  ki  +  ik2,  (5-6) 

where  i  =  \f—l,  so  that 

ipt  =  ku  +  ik2t  =  i  (ki  +  ik2)ss  +  i  ^  (*u  +  k%)  -  A(t)  (. ki  +  ik2) 

=  *  A  +  QlVf-W)  V’,  (5-7) 

where  A  denotes  the  Laplacian  operator  with  respect  to  s. 

In  fact,  (5.7)  can  be  simplified  somewhat  by  introducing  a  change  of  variables 
based  on  a  phase  factor,  as  observed  by  Hasimoto  (1972).  We  let 


ip  =  exp  ( i  /  A(a)da  I  ip 


so  that 


' ipt  =  iApt)  exp  ( i  /  A(a)da  I  ip  +  exp  I  i  /  A(a)da  I  ipt 


=  iA(t)ip  +  exp  j  A(a)daj  iAip  +  i 
=  exp  J  A(a)do^j  ^iAip  +  i-\ip\2ip^ 


-  A(t)  ip 
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We  have  thus  obtained 

ii>t  =  -  ^A+  (5.10) 

the  focusing  cubic  nonlinear  Schrodinger  equation  (without  the  additional  term 
involving  Aft)  in  (5.7). 


( b )  Steady  vortex  filaments 

The  NLS  (5.7)  thus  describes  how  the  natural  curvatures  of  the  vortex  filament 
evolve  with  time.  There  are  a  variety  of  solutions  to  (5.7),  including  ones  which  move 
(i.e.,  which  rotate  about  their  axis  or  translate)  without  changing  their  form  -  such 
solutions  are  stationary  solutions  of  (5.7),  i.e.,  they  satisfy  the  stationary  NLS.  One 
such  class  of  solutions,  whose  stability  properties  have  been  extensively  analyzed, 
are  helical  vortex  filaments  (Widnall,  1972).  Others  include  circular  rings,  closed 
coils,  planar  sinusoidal  curves,  and  curves  described  by  elliptic  functions  (Kida, 
1981). 

Thus,  the  solutions  to  the  fixed-endpoint  optimal  control  problem  on  SE( 3)  in 
section  4.b  are  closely  related  to  the  steady  vortex  filament  solutions,  since  both 
are  given  by  the  SNLS  equation.  There  are  cosmetic  differences  between  (5.7)  and 
(4.30),  such  as  the  role  of  fixed  endpoint  conditions  versus  the  DaRios-Betchov 
equation  for  determining  the  constants  which  appear  in  the  solutions.  Nevertheless, 
there  is  clearly  a  close  relationship  in  terms  of  the  form  of  the  solutions.  A  more 
subtle  question  is  whether  there  is  an  underlying  variational  principle  at  work  in 
both  the  optimal  control  and  physics  settings  which  explains  the  connection  between 
these  problems  at  a  deeper  level. 


6.  Conclusion 

The  present  paper  is  inspired  by  earlier  work  of  Baillieul  on  optimal  control  prob¬ 
lems.  We  have  shown  that  the  equations  governing  extremals  have  interesting  struc¬ 
ture  that  appears  to  be  previously  unknown.  Furthermore,  the  extremal  solutions 
for  a  particular  optimal  control  problem  on  SE{n)  are  associated  with  stationary  so¬ 
lutions  to  the  nonlinear  Schrodinger  equation  (for  n  =  3)  and  its  higher-dimensional 
generalizations  (for  n  >  4).  Connections  to  similar  solutions  which  appear  in  the 
study  of  vortex  filament  equations  have  also  been  described.  A  generalization  of 
the  methods  used  here  to  multiple  particles  in  SE( 2)  interacting  through  a  fixed 
communication  graph  can  be  found  in  Justh  &  Krishnaprasad  (2010). 


Acknowledgements 

This  research  was  supported  in  part  by  the  Air  Force  Office  of  Scientific  Research 
under  AFOSR  grant  FA9550710446;  the  Army  Research  Office  under  ARO  grant 
W911NF0610325;  by  the  ODDR&E  MURI2007  Program  Grant  N000140710734 
(through  the  Office  of  Naval  Research);  and  by  the  Office  of  Naval  Research. 


16 


E.  W.  Justh  and  P.  S.  Krishnaprasad 


References 

J.  Baillieul  (1975),  Some  Optimization  Problems  in  Geometric  Control  Theory ,  Pli.D. 
Thesis,  Harvard  University. 

J.  Baillieul  (1978),  “Geometric  methods  for  nonlinear  optimal  control  problems,”  J.  Opt. 
Theory  Appl.,  Vol.  25,  No.  4,  pp.  519-548. 

R.  Betchov  (1965),  “On  the  curvature  and  torsion  of  an  isolated  vortex  filament,”  J.  Fluid 
Mech.,  Vol  22,  pp.  471  -  479. 

R.  L.  Bishop  (1975),  “There  is  more  than  one  way  to  frame  a  curve,”  The  American 
Mathematical  Monthly,  Vol.  82,  No.  3,  pp.  246-251. 

H.  T.  Davis  (1962),  Introduction  to  Nonlinear  Differential  and  Integral  Equations,  Dover 
(Reprint). 

H.  Hasimoto  (1972),  “A  soliton  on  a  vortex  filament,”  J.  Fluid  Mech.  Vol.  51,  No.  3,  pp. 
477-485. 

V.  Jurdjevic  (1997),  Geometic  control  theory,  Cambridge  Univ.  Press. 

E.  W.  Justh  and  P.  S.  Krishnaprasad  (2002),  “A  simple  control  law  for  UAV  formation 
flying,”  Institute  for  Systems  Research  Technical  Report  TR  2002-38. 

E.  W.  Justh  and  P.  S.  Krishnaprasad  (2004),  “Equilibria  and  steering  laws  for  planar 
formations,”  Syst.  and  Control  Lett.,  Vol.  52,  No.  1,  pp.  25-38. 

E.  W.  Justh  and  P.  S.  Krishnaprasad  (2005),  “Natural  frames  and  interacting  particles 
in  three  dimensions,”  Proc.  ffth  IEEE  Conf.  Decision  and  Control,  pp.  2841-2846  (see 
also  arXivnnath.OC / 0503390vl) . 

E.  W.  Justh  and  P.  S.  Krishnaprasad  (2010),  “Extremal  Collective  Behavior,”  submitted 
to  the  49th  IEEE  Conf.  Decision  and  Control,  2010. 

E.  W.  Justh  and  P.  S.  Krishnaprasad  (2006),  “Steering  laws  for  motion  camouflage,”  Proc. 
R.  Soc.  A,  Vol.  462,  No.  2076,  pp.  3629-3643  (see  also  arXiv:math.OC/0508023). 

S.  Kida  (1981),  “A  vortex  filament  moving  without  change  of  form,”  J.  Fluid  Mech.,  Vol. 
112,  pp.  397-409. 

P.  S.  Krishnaprasad  (1993),  “Optimal  control  and  Poisson  reduction,”  Institute  for  Sys¬ 
tems  Research  Technical  Report  T.R.  93-87. 

J.  Langer  and  R.  Pcrline  (1991),  “Poisson  geometry  of  the  filament  equation,”  J.  Nonlin. 
Sci.,  Vol.  1,  No.  1,  pp.  71-93. 

J.  Langer  and  R.  Perline  (1996),  “The  localized  induction  equation,  the  Heisenberg  chain, 
and  the  nonlinear  Schrodinger  equation,”  in  W.  F.  Shadwick,  P.  S.  Krishnaprasad  and 

T.  S.  Ratiu  (eds.),  Mechanics  Day,  Fields  Institute  Communications,  Vol.  7,  pp.  181-187. 

P.  K.  Newton  (2001),  The  N-Vortex  Problem:  Analytical  Techniques,  Springer- Verlag,  New 
York. 

P.  V.  Reddy  (2007),  Steering  laws  for  Pursuit,  M.  S.  Thesis,  Univ.  of  Maryland. 

P.  V.  Reddy,  E.  W.  Justh  and  P.  S.  Krishnaprasad  (2006),  “Motion  camouflage  in 
three  dimensions,”  Proc.  IEEE  Conf.  Decision  and  Control,  pp.  3327-3332  (see  also 
arXiv:math.OC/0603176vl). 

R.  L.  Ricca  (1996),  “The  contributions  of  Da  Rios  and  Levi-Civita  to  asymptotic  potential 
theory  and  vortex  filament  dynamics,”  Fluid  Dynamics  Research,  Vol.  18,  pp.  245-268. 

S.  E.  Widnall  (1972),  “The  stability  of  a  helical  vortex  filament,”  J.  Fluid  Mech.  Vol.  54, 
No.  4,  pp.  641-663. 

C.  Wiggins  (2001),  “Biopolymer  mechanics:  stability,  dynamics  and  statistics,”  Mathe¬ 
matical  Methods  in  the  Applied  Sciences,  Vol.  24,  pp.  1325-1335. 

F.  Zhang,  E.  W.  Justh,  and  P.  S.  Krishnaprasad  (2004),  “Boundary  following  using  gyro¬ 
scopic  control,”  Proc.  f3rd  IEEE  Conf.  Decision  and  Control,  pp.  5204-5209. 


